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ABSTRACT:  Various  special  motion  planning  problems  involving 
arbitrarily  many  degrees  of  freedom  are  shown  to  admit  relatively 
simple  solutions  by  techniques  based  on  the  connectivity  graph  approach 
described  by  Schwartz  and  Sharir.  The  solutions  exploit  the 
particularly  simple  configuration  space  structure  of  the  robot  systems 
considered.  A  typical  problem  is  that  of  planning  motions  for  a  2-D 
robot  system  consisting  of  several  arms  all  jointed  at  one  common 
endpoint  and  free  to  rotate  past  each  other.  The  algorithm  given  for 
solving  this  problem  runs  in  time  0(nk+4)^  where  k  is  the  number  of 
arms. 


(*)  This  work  has  been  supported  in  part  by  ONR  Grant  N00014-82-K-0381 , 
by  a  Grant  from  the  U.S. -Israeli  Binational  Science  Foundation,  and  by 
a  Grant  from  the  Bat-Sheva  Fund. 


Introduction 


The  'Piano  Movers'  problem  (see  [Re],  [LPW])  is  that  of  finding  a 
continuous  motion  that  will  take  a  given  body  (which  may  consist  of 
several  rigid  subparts  jointed  together)  from  a  given  initial  position 
to  a  desired  final  position,  but  which  is  subject  to  certain  geometric 
constraints  during  the  motion.  These  constraints  forbid  the  body  to 
come  in  contact  with  certain  obstacles  or  'walls'.  Earlier  papers 
([SSI],  [SS2])  have  described  a  general  technique  for  solving  such 
problems,  which  is  based  on  decomposition  of  the  space  FP  of  free 
configurations  of  the  robot  system  into  connected  subcells,  and  an 
analysis  of  adjacency  relations  between  these  cells.  This  approach 
results  in  the  construction  of  a  discrete  connectivity  graph  whose 
nodes  represent  the  cells  in  the  decomposition  of  FP,  and  whose  edges 
connect  nodes  corresponding  to  adjacent  cells.  Search  for  a  continuous 
motion  between  two  specified  system  configurations  then  reduces  to 
searching  for  a  path  in  the  connectivity  graph  connecting  the  two  nodes 
corresponding  to  the  cells  containing  the  initial  and  final 
configurations. 

FP  is  a  k-dimensional  manifold,  where  k  is  the  number  of  degrees 
of  freedom  of  the  system.  To  decompose  FP  one  projects  it  onto  a 
subspace  A  of  lower  dimension,  and  then  partitions  A  into  connected 
regions,  each  such  region  R  having  the  property  that  connected 
components  of  the  'fiber  space'  P(X),  of  points  in  FP  projecting  into 
X,  vary  continuously  as  X  varies  in  R,  and  remain  qualitatively 
constant.  It  follows  that  each  such  region  R  gives  rise  to  a  fixed 
number  of  non-adjacent  cells  of  FP,  all  projecting  onto  R.  To  construct 
the  connectivity  graph,  one  must  calculate  adjacency  relationships 
between  cells  lying  above  R  and  cells  lying  above  R'  for  every  pair  of 
regions  R,R'  which  are  adjacent  in  A. 

The  advantage  of  this  technique  is  that  it  reduces  a  k-dimensional 
problem  into  decomposition  problems  involving  manifolds  of  lower 
dimensions.   For  systems  with  k=3,4  the   technique   has   been   used   to 


obtain  motion  planning  algorithms  for  a  line  segment  moving  in  2-D 
space  amidst  polygonal  barriers  (here  k=3),  and  for  two  independent 
circular  bodies  moving  in  the  same  environment  (k=A  for  this  problem). 
The  main  problem  one  faces  in  applying  this  technique  to  systems  with  a 
larger  number  of  degrees  of  freedom  is  that  normally  application  of 
this  projection  method  reduces  the  problem  to  similar  problems  for  a 
smaller,  but  still  large  k.  In  such  cases  it  is  often  possible  to  apply 
the  technique  recursively  to  the  reduced  problems,  repeating  this 
process  until  k  is  reduced  to  I  or  2;  for  the  low-dimensional  problems 
which  remain,  decomposition  can  then  be  performed  in  a  straightforward 
manner.  However,  each  step  of  projection  complicates  significantly  the 
geometric  structure  of  the  manifold  to  be  analyzed,  and  so  recursive 
application  of  the  technique  grows  difficult  after  two  or  three  levels 
of  recursion.  The  motion-planning  algorithm  for  three  independent 
circular  bodies  presented  in  [SS2]  which  involves  two  levels  of 
recursive  decomposition,  illustrates  this  point. 

The  point  of  this  paper  is  to  observe   that   for   certain   special 

robot   systems,   the  decomposition  of  the  configuration  space  FP  can  be 

accomplished  using  just  one   projection,   even   though   the   number   of 

degrees   of  freedom  involved  may  be  arbitrarily  large.   This  is  because 

the  resulting  fiber  spaces  P(X)  are  decomposable  as  Cartesian   products 

of   many  simple  subspaces  of  low  dimension.   This  observation  allows  us 

to  derive   relatively   simple  motion   planning   algorithms   for   these 

systems  (although  these  algorithms  have  complexity  which  grows 
exponentially  with  k).   In  Section  1  we  present  such  an   algorithm   for 

the   case   of   a  system  of  k  straight  segments  ('arms'),  jointed  at  one 

common  endpoint,  but  able  to   rotate   freely   about   that   point,   with 

unimpeded  motion  of  one  arm  past  the  other.   Motion  planning  for  such  a 

system  can   be   accomplished   using   a   simple   generalization   of   the 

motion-planning   techniques   of   [SSI]  for  a  single  straight  segment  (a 

'ladder').   In  section  2  we  comment  on  various  other  systems   involving 

arbitrarily   many   degrees   of   freedom  which  are  amenable  to  similarly 

simple  solution  techniques. 


Motion  Planning  Algorithm  for  a_    'Spider' 


In  this  section  we  generalize  the  'ladder'  case  of  the 
Piano-movers'  problem  discussed  in  [SSI]  to  an  spider  B  with  k  arms. 
This  sytem  consists  of  k  straight  segments  PQi  pQj  ___  pg,  ^n 
having  a  common  endpoint  P  about  which  each  segment  can  rotate  freely 
independently  of  the  positions  of  the  remaining  segments.  (In 
particular,  two  segments  can  rotate  past  one  another.)  We  will  refer  to 
the  segment  PQ^^  as  the  i-th  arm  of  the  spider,  and  denote  it  simply  by 
its  index  i.  The  lengths  d^^  =  iPQ^i,  i=l,...,k  need  not  be  equal,  and 
in  fact  are  assumed  to  be  distinct  from  each  other. 


The  region  V  in  which  B  is  free  to  move  is  assumed  to  be  bounded 
by  polygonal  walls,  having  the  same  properties  as  in  [SSI].  Each 
configuration  of  B  will  be  denoted  as  [  ^>^  i ,  . . .  ,61.  ]  ,  where  X  is  the 
position  of  P  and  where  6^^  is  the  orientation  of  the  i-th  arm  of  B. 
Fig.   1.1  shows  an  instance  of  the  'spider'  motion-planning  problem. 


final  position-- 


Fig.  1.1.   An  instance  of  the  'spider'  motion  planning  problem 


Assume  that  B  is  to  be  placed  in  V  with  P  at  .s(jme  puinL  X.  X  is 
called  an  admissible  point  if  there  exists  at  least  one  orientation 
tuple  6  =  [e  J  ^  ,  ,  ,  ^Qj^]  such  that,  at  position  [X,ei,  B  does  not  toucli  any 
wall.  We  will  call  a  position  of  B  at  which  it  does  not  touch  any  wall 
a  free  position,  and  a  position  of  B  at  which  it  does  not  cross  thru 
any  wall  a  semi-free  position.  (Thus,  a  semi-free  position  is  either  a 
free  position  or  a  position  at  which  B  touches  a  point  of  some  wall, 
but  does  not  enter  the  interior  of  the  wall  region.)  The  set  FP  of  all 
free  positions  of  B  is  plainly  an  open  k.+  2-dimensional  manifold,  and 
the  set  SFP  of  all  semi-free  positions  is  closed. 

Similarly,  for  each  i=l,...,k,  we  call  a  position  [X,e.]  qJ  ^Y\e 
i-th  arm  of  B  a  free  position  of  ^,  if  at  this  position  i  does  not 
touch  any  wall.  FP^  denotes  the  3-D  set  of  all  free  positions  of  i. 
Likewise,  [^,6^]  ^g  ^  semi-free  position  for  i_  if  at  this  position  i 
does  not  cross  through  any  wall,  and  SFP^  denotes  the  3-D  set  of  all 
semi-free  positions  for  i.  Note  that  FP.  (resp.  SFPi)  is  the  set  of 
free  (resp.  semi-free)  positions  of  a  single  straight  segment  of 
length  d^^  as  defined  in  [SSI]. 

To  analyse  the  irregularly  shaped  k+2-dimensional  manifold  SFP,  we 
project  it  into  the  2-diTnensional  region  in  which  the  point  P  is  free 
to  move,  and  then  consider  the  set  of  orientation  tuples  available  to  B 
for  each  fixed  position  of  P.  As  in  [SSI],  we  have 


Lemma  1.1:  For  each  fixed  admissible  position  X  of  P,  and  for  each 
i=l,...,k,  the  set  O^^x)  of  all  orientations  representing  free 
positions  of  i  is  a  finite  collection  of  open  angular  sectors,  whose 
endpoints  represent  semi-free  orientations  of  i.  (Note  that 
orientations  are  represented  by  angles  6^  on  the  unit  circle.) 


Lemma   1.1  implies  that  the  set  0(X)  of  all  orientation  tuples  6  = 
f^l,---,ek]  for  which  [X,e]  e  FP,  is  given  by  0(X)  =  R  Oi(X),  and  is  an 
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open  set  consisting  of  a  finite  collection  of  connected  cells,  each  of 
which  is  a  Cartesian  product  of  k  angular  sectors. 

We  will  use  also  the  following  notations.  For  each  i=l,...,k  we 
denote  by  0^*(X)  the  set  of  all  serai-free  orientations  of  the  i-th  arm 
of  B  (when  P  is  fixed  at  X).  The  Cartesian  product  0*(X)  =  H  0^*iX)  is 
the  set  of  all  orientation  tuples  6  for  which  [X.G]  e  SFP.  For  each 
i=l,...,k  we  denote  by  T^(x)  the  set  Oi*(X)-0^(x)  of  touches  of  the 
i-th  arm  of  B.  Then  plainly  for  each  orientation  tuple  9  e  0*(X)-0(X) 
there  exists  at  least  one  i  such  that  6^  e  T^CX). 

The  following  lemma  and  corollary  fol-low  by  easy  adaptation  of  the 
arguments  used  to  prove  similar  statements  in  [SSI]. 

Lemma  1.2:  Let  X  be  an  admissible  point.  Then  for  each  e  >  0  and  each 
i=l,...,k  there  exists  a  neighborhood  N  of  X  such  that  for  all  Y  e  N, 
each  point  of  0^*(Y)  lies  within  a  distance  e  of  some  point  of  Oi^*(X), 
and  conversely  each  non-isolated  point  of  0^*(x)  lies  within  a  distance 
e  of  some  point  of  0£*(Y). 


Corollary:  If  X  is  an  admissible  point,  then  for  each  compact 
subinterval  K  of  0^(x)  there  exists  a  neighborhood  N  of  X  such  that  for 
each  Y  e  N,  O^Cy)  contains  K. 


Each  point  in  the  set  T^(x)  =  Oi*(X)  -  0^(x)  introduced  above 
represents  an  orientation  6^  for  which  PQ^  touches  a  wall  section  W, 
either  at  its  extremity  Q^  or  at  a  point  intermediate  between  P  and  Q^ . 
In  what  follows  we  shall  label  each  such  point  6^  (in  T^(X))  with  the 
set  Sj^(e^,X)  of  wall  sections  W  touched  by  the  i-th  arm  of  B  when  this 
arm  is  given  the  orientation  6^  with  P  at  X. 


Definition   1.1:   (a)   Let   l<i<k,  and  let  [X,e^]  c  SFP^.   Give  PQ^  the 
position/orientation  [X,e^],  and  extend  the  segment  PQ^  to   a   line   L. 
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Let  S  be  Che  side  of  L  that  PQ^  will  enter  if  turned  slightly  in  the 
clockwise  (resp.  counterclockwise)  direction.  Let  W  be  a  wall 
section,  and  suppose  that  when  PQ^  is  given  the  position/orientation 
[X.^i]  it  touches  W.  If  the  intersection  of  W  with  the  circle  of  center 
X  and  radius  equal  to  the  length  of  PQ^  lies  entirely  within  S,  then 
[X,e^]  is  called  a  clockwise  (resp.  counterclockwise)  stop  of  i 
against  W. 

(b)  For  each  i=l,...,k,  the  set  of  pairs 
(ISiCe^.X),  SiCGi'.X)]  :  6i,  Gi'  e  Ti(X)  | 

Si  is  a  clockwise  stop,  Q j_'    is  a  counterclockwise  stop,  and 
the  whole  interval  between  9^  and  6^'  belongs  to  Oi(X)  } 

is  called  the  i-th  characteristic  of  X  and  will  be  written  as  a^(x), 

(c)  The  characteristic  a(X)  of  X  is  defined  to  be  the  Cartesian  product 
n  Oi(X). 

It  is  easy  to  prove  the  following  two  lemmas  and  corollary  by 
adapting  the  arguments  used  in  [SSI]  to  prove  corresponding  statements 
for  the  case  of  a  single  ladder. 

Lemma  1.3:  Let  Ki<k.  Let  X^  +  x  and  suppose  that  a  wall  section  W 
belongs  to  all  the  sets  s^(e^^^x)  for  all  n  and  for  some  6^^  c  TiCX^). 
Then  the  limit  orientation  6^  of  any  convergent  subsequence  of  the  B^^^ 
belongs  to  Tj^(x),  and  W  c  SiCe^.X).  Furthermore,  if  for  all  n, 
[X^.Gj^j^]  is  a  clockwise  (resp.  a  counterclockwise)  stop  of  i  against 
W,  then  [X,e^]  ig  also  a  clockwise  (resp.  counterclockwise)  stop  of  i 
against  W. 


Lemma  1.4:  Let  Ki<k.  (a)  If  [X,e^]  ig  the  clockwise  (resp. 
counterclockwise)  endpoint  of  an  interval  of  0^*(X),  it  is  a  clockwise 
(resp.   counterclockwise)  stop  of  i  against  W. 


(b)  If  [X,e^]  and  [X,6j^']  are  both  clockwise  (resp.  counterclockwise) 
stops  of  i  against  W,  then  6^  =  9^'. 

(c)  If  [X,e^]  is  a  position/orientation  of  PQ^  such  that  6^  e  T^CX)  and 
such  that  PQ^  touches  a  convex  wall  section  W,  then  it  is  either  a 
clockwise  stop  or  counterclockwise  stop  of  i  against  W,  or  both. 

Corollary:  For  each  i=l,...,k,  each  wall  section  W  and  each  admissible 
point  X,  there  are  at  most  two  orientations  6^^  e^'  e  T^CX)  at  which 
PQi  touches  W. 

Definition  1.2:  Let  l<i<k.  and  let  X  be  an  admissible  point.  For  each 
wall  section  W  which  labels  a  clockwise  stop  (resp.  a  counterclockwise 
stop)  in  T^(x),  we  let  ij^iCX.W)  (resp.  i|/i'(X,W))  denote  the  unique 
clockwise  (resp.   counterclockwise)  stop  G^  such  that  W  e  si(ei,X). 

If  aj_(x)  is  null  we  will  find  it  technically  convenient  in  what  follows 
to  introduce  a  nominal  element  Q  of  Oi(x)  and  to  define  i!i(X,2)  to  be 
the  angle  0,  and  i>i' (X,Q)    to  be  the  angle  360. 

We  continue  to  argue  in  a  manner  paralleling  [SSI]:  The  next  three 
lemmas  follow  by  straightforward  adaptation  of  the  arguments  given  in 
that  paper. 

Lemma  1.5:  Suppose  that  P  lies  at  an  admissible  point  X  of  V  which  has 
the  following  properties: 

(*)  For  each  i=l,...,k  there  does  not  exist  a  semi-free  orientation  of 
i  (with  P  at  X)  such  that  PQ^  touches  the  boundary  of  V  in  more  than 
one  point. 

(**)  For  each  i=l,...,k  there  does  not  exist  a  semi-free  orientation  of 
i  (with  P  at  X)  in  which  PQ^  touches  a  wall  perpendicularly  at  Q,  or  in 
which  the  extremity  Q^  of  PQ^  touches  a  corner  or  end  of  a  wall 
section. 
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Let  e  c  T(X).   Then  for  each  i=l k  for  which   the   orientation 

^i  is  a  touch,  6  j^  is  not  an  isolated  point  of  0^  (X),  and  is  not  the 
end-point  of  more  than  one  arc  of  0^*(X).  Moreover,  Sj^(6j^,X)  contains 
just  one  wall  section  W. 


Lemma   1.6:  The  set  of  points  satisfying  the  hypotheses  (*)  and  (**)  of 
Lemma  1.5  is  open. 


Lemma  1.7:  Let  X  satisfy  the  hypotheses  of  Lemma  1.5.  Then  there 
exists  an  open  neighborhood  N  of  X  such  that  for  Y  e  N  we  have  a(Y)  = 
a(X),  and  for  each  i=l,...,k.,  0^*(Y)  consists  of  exactly  as  many  arcs 
as  0^*(X).  Moreover  if  [W.W  ]  c  o^(x)  =  ai(Y)  then  i^i(Y,W)  (resp. 
'*^i'(Y,W'))  depends  continuously  on  Y  for  Y  e  N. 


Let  V  be  the  locus  of  all  points  violating  one  of  the  conditions 
(*),  (**)  of  Lemma  1.5.  We  will  see  below  that  V  is  the  union  of  a 
finite  collection  of  curves,  which  we  call  the  critical  curves  of  our 
case  of  the  mover's  problem.  Removal  of  these  critical  curves  divides 
the  two  dimensional  space  of  all  admissible  points  into  a  finite 
collection  of  connected  open  regions  R,  which  we  call  the  noncritical 
regions  of  our  problem.  The  following  corollary  is  an  immediate 
consequence  of  what  has  already  been  shown: 


Corollary :  The  set  a(X)  is  constant  on  each  connected  subregion  R  of 
the  set  A  of  admissible  positions  for  which  R  contains  no  critical 
curve . 


Definition   1.3:  For  each  such  R  we  put  a(R)  =  o(X),  where  X  is  a  point 
chosen  arbitrarily  from  R. 


The  critical  curves  of  our  problem  fall  into   the   four   following 
categories . 

Type  I_:  For  each  convex  wall  section  W  and  for  each  i=l,...,k,  the 
locus  of  all  points  at  distance  d^  from  W; 

Type  II:  For  each  common  endpoint  Z  of  a  pair  of  neighboring  wall 
sections  and  for  each  i=l,...,k,  the  circle  of  radius  d^  about  Z; 

Type  III:  For  each  wall  section  W^  and  each  corner  C  of  a  different 
wall  section  W2,  the  set  of  all  points  traced  by  P  as  the  i-th  arm  PQ^ 
of  B  moves  touching  W^  and  C.  (See  Figs.   l.A(a),  1.4(b)) 

Type  IV:  For  each  wall  section  W  and  each  i=l,...,k,  the  set  of  all 
points  traced  by  P  as  PQ^  slides  along  an  edge  of  W.  (See  Fig. 
1.4(c).) 
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Fig.  1.2.   Type  I  critical  curve; 
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Fig.  1.3.   Type  II  critical  curves 


Fig  1.4(a).   PQj  in  contact  with 
two  walls.  Qj^  lies  along  a_   wall. 


Fig.  1.4(b).   PQ-j  in  contact  wit_h 
two  walls.  Qj_  does  not  lie  along 
a  wall. 
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Fig.  1.4(c).  PQj^  in  contact  with  two  points  of  the  same  wall. 


These  four  types  of  critical  curves  coincide  with  the  critical 
curves  arising  in  the  case  of  a  single  segment,  as  described  and 
analyzed  in  detail  in  [SSI].  We  will  refer  to  a  critical  curve 
consisting  of  positions  at  which  the  i-th  arm  can  have  a  critical  wall 
contact,  a  critical  curve  for  i.  Note  that  there  are  0(kn2)  critical 
curves  for  a  k-armed  spider. 


Lemma  1.8:  Let  R  be  a  connected  open  noncritical  subregion  of  the  set  A 
of  all  accessible  points.  Then  one  can  move  continuously  through  FP 
from  a  given  free  position  and  orientation  tuple  [X,e]  to  another  such 
[X',e']  where  both  X,  X'  e  R,  via  a  motion  during  which  P  remains  in  R, 
if  and  only  if  for  each  i=l,...,k  the  clockwise  endpoint  Yi(e,X)  of  the 
arc  of  0^*(X)  to  which  6^  belongs  has  a  'marking'  s^C Yi( 6^ ,X) ,X)  equal 
to  the  'marking'  s^{y ^(q^'  ^x' ) ,X' )    of  the  endpoint  Yi(ei',X'). 

Proof :  It  follows  readily  from  the  proof  of  Lemma  1.7  that  for  each 
i=l,...,k,  the  endpoint  YiCe^^.Y)  changes  continuously  as  [Y,e]  moves 
continuously  through  FP  with  Y  remaining  in  R,   and   that   the   marking 
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^i(Yi(9 1 ,Y) ,Y)  cannot  change  during  such  a  moCion.  This  proves  the 
'only  if  part  of  the  present  lemma. 

For  the  converse,  take  a  curve  c(t),  0  <  t  <  1,  that  connects  X  to 
X'  in  R.  Fix  l<i«k,  and  let  W^  be  the  unique  element  of  s^C Yi( 6^ ,X) ,X) 
=  s^(Yi(e^' ,X' )  ,X').  Let  Yi^*^  =  "Y^'CS^.X)  denote  the  counterclockwise 
end  of  the  interval  of  0^*(X)  containing  6^,  and  let  W-j^ '  be  the  unique 
element  of  s^(-y.cc^x).  Note  that  by  Lemma  1.7  W^'  is  also  the  unique 
element  in  Sj^Cy  j^' (6^' ,X' )  ,X' ) .  Then  plainly  6^  and  6^'  belong  to  the 
open  angular  intervals  C^iCX.W^)  ,  ij.^' (X.W^  '  ) )  and  (tl^^CX' .W^  )  , 
'I'i' (X' ,Wj^' ) )  respectively.   By  Lemma  1.7,  the  mapping 

t^  [c(t),  ((j^iCcCt),;^!)  +  4;i'(c(t),Wf  ))/2  ,..., 

(^k(c(t),Wi,)  +  4'k'(c(t),W^,'))/2  ] 

defines  a  continuous  free  motion  of  B  through  R.  Since  for  each 
i=l,...,k  we  have  6^  e  (i>i{X,V^)  ,^1^'  iX,Vi'  ))  and  9^'  e 
("J^iCX' .W^)  ,i|)j^' (X' ,Wi' ) ) ,  it  is  clear  that  by  performing  appropriate 
rotations  of  the  various  arms  of  B  before  and  after  this  motion  we  can 
pass  between  the  specified  initial  and  final  positions  of  B  via  a 
continous  motion  of  B  through  FP  with  P  remaining  in  R.  Q.E.D. 


Definition  1.4:  Let  R  be  a  connected  open  noncritical  region.   Then 

(a)  C(R)  is  the  set  of  all  free  positions/orientations  [X,e]  such  that 
X  c  R. 

(b)  'If  5  =  [[W^^w^',  ...  ,[Wi^,Wi^']]  e  o(R),  then  C(5,R)  is  the  set  of 
all  [X,e]  c  C(R)  such  that  6  belongs  to  the  product  of  the  open 
intervals  (i|'i(X,Wi)  .-J^^' (X,Wi  '  ) ) ,  i=l,...,k. 

It  is  obvious  from  Lemma  1.8  that  the  connected  components  of  C(R)  are 
the  sets  C(^ ,R) ,  ^  £  a(R). 
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Next  we  consider  what  happens  when  B  crosses  between   regions   R, 

^2  separated  by  a  critical  curve.  The  following  simple  lemma 
generalizes  a  similar  lemma  given  in  [SSI],  and  rules  out  extreme  cases 
that  would  otherwise  be  troublesome. 


Lemma  1.9:  Let  p( t)=[x( t) ,6 ( t ) ]  be  a  continuous  curve  in  the  open 
(k+2)-dimensional  manifold  FP  of  free  positions  of  B.  Suppose  that  the 
end-points  [X.G],  [X',e']  of  p  are  specified.  Let  {Xj..Xj^}  be  any 
finite  collection  of  points  in  the  2-dimensional  space  V  not  containing 
either  X  or  X'.  Then  by  moving  p  slightly  we  can  assume  that,  during 
the  motion  described  by  p,  P  never  passes  through  any  of  the  points 
Xi..X^. 

Proof:  See  the  proof  of  Lemma  1.9  of  [SSI]. 

Remark:  As  in  [SSI],  a  similar  argument,  based  on  Sard's  lemma  shows 
that  by  modifying  any  given  free  motion  very  slightly,  we  can  always 
ensure  that  the  curve  x(t)  traced  out  by  P  during  the  motion  p  has  a 
nonvanishing  tangent  everywhere  along  its  length,  and  that,  given  any 
finite  set  3^,..,gj^  of  smooth  curves  in  two-dimensional  space,  we  can 
assume  that  the  tangent  to  x(t)  lies  transversal  to  B^  at  any  point  in 
which  x(t)  intersects  gj  (see  [Sc]).  Moreover,  we  can  assume  that  e(t) 
is  constant  and  x(t)  is  linear  in  t  for  all  points  along  p  lying  in  a 
sufficiently  small  neighborhood  of  each  such  intersection. 

It  follows  from  [SSI]  that  the  critical  curves  of  the  case  of  the 
mover's  problem  considered  here  are  always  smooth,  and  that  two 
critical  curves  can  have  only  finitely  many  intersections.  Thus  to 
characterise  the  connected  components  of  the  (k+2)  dimensional  manifold 
FP,  it  is  sufficient  to  analyse  what  happens  as  P  =  x(t)  crosses 
between  regions  Ri,R2  along  a  line  L  transversal  to  a  critical  curve  B 
separating  these  two  regions,  such  that  L  does  not  not  pass  through  any 
point  common  to  two  critical  curves.  Moreover,  we  can  suppose  that 
each  6^  maintains  a  constant  orientation  in  the  neighborhood  of  each 
such  crossing. 
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Lemma  1.10:  Suppose  that  (a  portion  of)  the  critical  curve  B  forms  part 
of  the  boundary  of  a  noncritical  region  R,  and  that  E,  = 
[  [Wi.Wi' ],...,  [Wi<.,W|^' ]  I  e  o(R).  Let  X  c  g,  and  let  Y^  e  R,  and  Y^  ->■  X. 
Then  for  each  i=l,...,k  the  sequence  'I'iCYn.Wi)  (resp.  li-i' (Yn,  Wi '  ) ) 
converges  to  iJ^i(x,Wi)  (resp.  i+'i' (X.W^ '  ) ) .  Moreover,  the  function 
't'iCX.Wj^)  (resp.  (J'i' (X.Wj^' ) )  depends  continuously  on  X  for  X  e  g. 
Finally,    the    entire    (counterclockwise)    open   angular    sector 

(*i(X,Wi),i|;i'(X,Wi'))  belongs  to  Oi*(X). 

Proof :  Similar  to  the  proof  of  Lemma  1.10  of  [SSI]. 


Lemma  1.11:  Suppose  that  (a  portion  of)  a  smooth  critical  curve  6 
separates  two  connected  noncritical  regions  Ri,R2  and  that  R1+R2+3  is 
open.  Let  ^i  =  [[W^^Wif  ]  ,...,  [  Wjii,  .W^i,' ]  ]  t  o(Ri)  (resp.  ^2  = 
[[W2i,W2i']  ,...,  [W2k,W2k']]  e  a(R2)),  and  let  C^  =  C(Ci,Ri),  and  C2  = 
C(C2,R2)'   Then  the  following  two  sets  of  conditions  are  equivalent: 

Condition  A:  There  exists  a  point  X  e  3  such  that  for  each  i=l,...,k 
the  open  angular  intervals  (>^i(X,Wii)  ,4^^' (X,  W^^  '  ) )  and  (i|^i(X,W2i  )  , 
'i'i' (X,W2i' ))  are  subsets  of  0^  (X)  and  have  a  non-null  intersection. 

Condition  B^:  There  exists  a  smooth  path  c(t)  =  [x(t),e(t)]  e  FP  which 
has  the  three  following  properties: 

(i)  c(0)  e  Ci,  c(l)  e  C2; 

(ii)  x(t)  e  R1+R2+6  for  all  0<t<l; 

(iii)  x(t)  crosses  g  just  once,  transversally ,  when  t:  =  tQ^  0<tn<l,  and 
e(t)  is  constant  for  t  in  the  vicinty  of  to. 

Note  that  condition  B  amounts  to  saying  that  C^  and  C2  lie  in  the  same 
arcwise  connected  (and  hence  connected)  component  of  FP  (see  also  the 
remarks  made  in  Definition  1.4). 
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Proof :  The  proof  of  Lemma  1.11  of  [SSI]  applies  here  as  well. 


Next  we  show  that  if  3  is  an  (open)  critical  curve  section  not 
Intersected  by  any  other  critical  curve,  and  if  condition  A  of  Lemma 
1.11  holds  for  one  point  X  along  3,  then  it  holds  for  all  X  along  C 
This  makes  it  easy  to  calculate  the  relationships  of  connectivity  in 
which  we  are  interested  by  applying  Lemma  1.11  to  an  arbitrarily 
selected  point  of  S> . 


Lemma  1.12:  Let  the  smooth  critical  curve  3  separate  the  two 
noncritical  regions  R^^  R2.  Let  3'  be  a  connected  open  segment  of  3 
not  intersecting  any  other  critical  curve,  and  suppose  that  3'+R2-fR2  is 
open.  Let  E,  ^  =  [[Wii,Wii']  ,...,  [Wii^.W^k']]  eo(Ri)  (resp.  ^2  = 
[[W2i,W2i']  ,...,  [W2k,W2k']]  e  oCR2))-  Then  the  set  of  X  e  3'  for 
which  for  each  i=l,...,k  the  open  clockwise  angular  sectors  (<iij^(x,W]^j^) , 
1^i'(X,Wii'))  and  (4^i(X,W2i),  i^^i' (X,'.^2i' ) )  ^^^  subsets  of  Oi*(X)  and 
overlap  is  either  all  of  3'  or  is  empty. 

Proof:  The  proof  of  Lemma  1.12  of  [SSI]  can  be  applied  here. 

Remark ;  If  one  assumes  that  no  two  critical  curves  coincide  with  one 
another  (which  assumption  is  discussed  below),  then  the  statements  of 
the  three  preceding  lemmas  can  be  simplified.  Indeed,  suppose  that  the 
curve  section  3  appearing  in  these  lemmas  is  a  critical  curve  for  the 
i-th  arm.  Then  as  3  is  crossed  the  characteristics  o-:(x)  remain 
unchanged,  and  each  connected  sector  of  0^*{X)  varies  continuously,  for 
all  j  5'  i.  Discontinuous  changes  can  occur  only  for  the  configuration 
space  features  connected  with  the  i-th  arm.  This  remark  makes  the 
connection  between  the  three  preceding  lemmas  and  their  counterparts  in 
the  case  of  a  single  ladder  even  more  obvious. 

As  in  [SSI],  the  chain  of  lemmas  described  so  far  enables  us  to 
reduce  the  case  of  the  movers'  problem  considered  here  to  a  finite 
combinatorial  search: 


Definition  1.5:  The  connectivity  graph  CG  of  an  instance  of  our  case  of 
the  movers'  problem  is  an  undirected  graph  whose  nodes  are  all  the 
pairs  [R,C],  where  R  is  a  connected  open  noncritical  subregion  of  V  and 
where  5  c  o(R).  An  edge  connects  two  nodes  [^i.^^]  and  [R2,^2]  i"  CG 
if  and  only  if  the  following  conditions  hold: 

(1)  Rj  and  R2  are  adjacent  and  meet  along  a  critical  carve  6. 

(2)  There  exists  a  (maximal)  open  portion  d'  of  e  contained  in  the 
common  boundary  of  Rj  and  R2  and  not  intersecting  any  other  critical 
curve,  such  that  for  some  (hence  every)  point  X  on  B '  the  open  angular 
sectors  (<|'i(X,Wii)  .ip^' (X.W^i  ' )  )  '  and  (<|)i(X,  W2i)  ,4^i' (X,W2i  '  ) )  overlap  fc3r 
each  i=l,...,k,  where  E,^  =  [[Wii.Wn'j  ,...,  [Wik.Wii<_' ]  ]  and  where  ^2  = 
[["21. "21']  .....  [W2k,W2k']]. 

We  are  now  in  position  to  state  our  main  theorem: 

Theorem   1.1:  There  exists  a  motion  c  of  B  through  the  space  FP  of  free 
positions  from  an  initial  [X,e]  to  a  final  [X',e']  if  and  only   if   the 
vertices   [R,S]   and   [R',S']   of   the  connectivity  graph  CG  introduced 
above  can  be  connected  by  a  path  in  CG,  where   R.   (resp.    R' )   is   the 
noncritical  region  containing  X  (resp.   X'),  and  where 
S  =  [  [si(Yl(ei,X),X)  ,  si(Ti'(8i,X),X)],..., 
tsk(Yk(ek.X),X)  ,  sic(Yk'(6k.X).X)]  ]. 
and 

s'  =  [  [si(Yi(ei',x'),x')  ,  si(Yi'(ei',x'),x')],..., 
tsk(Yk(ek'.x').x')  ,  sk(Yk'(ek'.x').x')]  ], 

Remark:  For  this  theorem  to  apply,  X  and  X'  should  not  lie  on  a 
critical  curve.  Thus  if  X  lies  on  a  critical  curve  we  first  move  B  a 
little  so  as  to  change  X  to  a  point  inside  some  noncritical  region,  and 
then  apply  the  theorem  as  stated  above. 

Proof:  Same  as  the  proof  of  Theorem  1 . 1  of  [SSI]. 
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If  we  assume  that  no  two  critical  curves  overlap,  it  follows  that 
if  3  is  a  critical  curve  generated  by  the  i-th  arm  of  B,  then  as  we 
cross  B  from  a  region  R^  to  a  region  R2  precisely  one  interval  (or  a 
pair  of  related  intervals)  of  0^(x)  or  its  'marking'  changes 
discontinuously  as  X  crosses  6,  in  one  of  the  three  following  ways: 

(i)  One  interval  of  0^(x)  may  shrink  to  a  point  and  then  disappear  (or 
vice-versa  one  new  interval  may  appear). 

(ii)  As  we  leave  R^  a  new  stop  of  i  may  appear  within  some  interval  I 
of  Oj^(x),  dividing  I  into  two  parts  which  then  pull  apart  as  we  move 
into  R2. 

(iii)  As  we  cross  6  the  'marking'  S'  of  one  endpoint  of  some  interval 
may  change  to  S' ' . 

Furthermore,  for  each  j  *  i,  the  structure  and  labeling  of  the 
components  of  Oj(x)  remain  unchanged  as  3  is  crossed.  It  follows  that 
the  structure  of  0(X)  itself  changes  in  a  way  very  simply  related  to 
the  manner  in  which  ©^(x)  changes. 

Suppose  for  specificity  that  a(R^)  always  contains  as  many  points 
as  a(R2).  Then  in  case  (i)  a(Ri)  contains  a(R2),  and  o(Ri)  -  a(R2) 
contains  several  elements,  all  having  the  same  i-th  component  i.  In 
this  case,  we  connect  each  node  [R2,S],  S  e  o(R2)  such  that  S^  ^  t ,  of 
the  connectivity  graph  CG  to  [Ri,S],  but  leave  each  node  [Ri,S]  for 
which  Sj^  =  T  ,  unconnected  to  any  node  [R2,S]. 

In  case  (ii)  all  the  elements  of  o(R2)  -  o(R][)  have  the  same  i-th 
component  t  =  [Wi,W2],  and  all  the  elements  of  a(Ri)  -  a(R2)  have  as 
their  i-th  component  one  of  the  pairs  t^  =  [W2,W],  12  =  [W,W2].  Here 
we  connect  each  node  [R^.S]  to  [R2,S]  for  those  S  satisfying  Si  * 
''•»^1.T2,  but  connect  each  node  [R2,S]  to  both  [Rj.S']  and  [R^.S''], 
where  5^=1,  Si'=Ti,  Si''^''^2>  ^^^  where  Sj  =  Sj'=Sj''  for  each  j*i. 
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In  case  (iii)  all  elements  in  o(Rj)  _  o(R2)  have  the  same  i-th 
component  t,  and  all  elements  of  o(R2)  -  oCRj)  have  the  same  i-th 
component  t'.  In  this  case  we  connect  [Rj.S]  to  [R2,S]  for  each  S 
satisfying  S^  t  t,t',  but  connect  [Ri,S]  to  [R2,S'],  for  each  S,S'  such 
that  S^=T ,  Si'=T',  and  Sj=Sj'  for  each  j^i. 

If  two  or  more  critical  curves  coincide,  we  can  separate  between 
them  by  an  infinitesimal  displacement  of  the  walls  or  arm-lengths 
defining  them.  This  creates  an  iaF iaitesimally  narrow  strip  between 
the  displaced  curves.  Then,  by  regarding  this  strip  as  a  noncritical 
region,  we  can  obtain  the  crossing  rules  of  the  originally  coinciding 
curves  as  combinations  of  the  crossing  rules  applying  to  each  of  the 
individual  curves.  This  technique,  described  in  detail  in  [SSI],  can 
be  easily  adapted  to  the  present  situation. 


Sketch  and  analysis  of  the  motion-planning  algorithm  for  £  spider 

The  preceding  analysis  can  be  easily  developed  into  a 
motion-planning  algorithm  for  a  spider.  The  algorithm  is  very  similar 
to  the  algorithm  developed  for  the  case  of  a  ladder  in  [SSI].  Indeed, 
partitioning  of  the  space  V  into  noncritical  regions  can  proceed 
exactly  as  in  the  case  of  a  ladder,  with  the  sole  difference  that  the 
case  of  a  spider  involves  more  critical  curves  (although  these  have  the 
same  types  as  in  [SSI].  Note  that  the  set  of  critical  curves  for  the 
present  'spider'  problem  is  simply  the  union  of  the  sets  of  critical 
curves  for  the  motion  of  each  of  the  spider's  arms,  and  that  the 
crossing  rule  applicable  to  each  of  these  critical  curves  relates  in 
the  simple  combinatorial  manner  described  above  to  the  crossing  rules 
governing  the  single-arm  critical  curves.) 

After  using  the  critical  curves  to  partition  the  space  V  we  go  on 
to  construct  the  connectivity  graph.  For  each  noncritical  region  R  and 
for  each  i=l,...,k,  we  can  compute  o^(r)  by  picking  an  arbitrary  point 
X  e  R  and  by  computing  a^(x),  applying  the  technique  of  [SSI]  to  the 
i-th   arm   of   B.   The  characteristic  o(R)  is  obtained  as  the  Cartesian 
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product  of  all  Che  characteristics  Oi(X).  We  can  then  build  the 
connectivity  graph  CG,  using  the  crossing  rules  stated  above  in  a 
straightforward  manner,  and  finally  search  through  this  graph  to  find  a 
path  connecting  the  two  nodes  corresponding  to  the  initial  and  final 
given  configurations  [  X,e  ^ ,  .  ,  .  ,ej^]  and  [X' ,Q  i' ,  .  .  .  ,d^' ]  of  the  spider. 
(To  find  these  nodes,  we  first  find  the  connected  noncritical  regions 
R,  R'  containing  X,  X'  respectively,  and  then  find,  for  each  i,  the 
labels  of  the  endpoints  of  the  angular  sectors  containing  6^^  e^^' 
respectively.  These  labels  and  regions  define  the  required  nodes  of 
CG.) 

To   analyze  the  complexity  of  the  algorithm,  we  have  only  to  adapt 
Lemma  3.1  of  [SSI],  obtaining 

Lemma  1.13:  The  total  number  of  critical  curve  sections  and  noncritical 
regions  is  OCk^n^).  Also,  for  each  admissible  point  X,  the  total 
number  of  components  of  0(X)  (that  is,  the  size  of  a(X))  is  O(n^). 

Proof :  The  first  statement  follows  as  in  Lemma  3.1  of  [SSI]  because 
there  are  0(k.n'^)  critical  curves.  The  second  statement  follows  because 
0(X)  is  a  Cartesian  product  of  k  subspaces,  each  of  which  can  have  at 
most  0(n)  components,  again  by  Lemma  3.1  of  [SSI].   Q.E.D. 


From  this  last  lemma  the  total  number  of  nodes  and  vertices  in  CG 
is  seen  to  be  ©(k^n*^"*"!^) ,  and  it  is  also  easy  to  construct  CG  within 
this  time  bound,  using  the  technique  sketched  above.   Thus  we  have 

Proposition  1.1:  The  running  time  of  our  algorithm  is  0(k2n'<'+'^)  ,  where 
k  is  the  number  of  the  spider's  arms,  and  where  n  is  the  number  of  wall 
edges. 
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2.  Possible  Extensions 


The  Cechnique  described  in  the  preceding  section  can  be  applied  to 
other  robot  systems  having  similar  decomposability  properties.  As  a 
first  example,  consider  the  system  B  consisting  of  a  rigid  2-D  cart  to 
which  there  are  affixed  k  straight  arms  at  various  points,  each  free  to 
rotate  about  the  point  of  contact  with  the  cart,  unimpeded  by  the 
positions  of  the  other  arras.  Suppose  first  that  the  motion  of  the  cart 
itself  is  restricted,  e.g.  that  it  can  only  translate  without 
rotations,  and  that  the  arms  attached  to  it  move  in  a  space  confined  by 
polygonal  barriers  as  in  the  preceding  section.  Then  we  can  plan  the 
motion  of  this  system  using  a  technique  quite  similar  to  that  described 
above.  More  specifically,  we  project  the  space  FP  of  free  positions  of 
B  onto  the  one-dimensional  space  of  the  positions  of  the  cart  itself. 
For  each  such  position  X,  the  space  0(X)  of  the  tuples  of  orientations 
of  the  arms  of  B  is  decomposable  into  the  Cartesian  product  of  the 
spaces  0^(x)  of  free  orientations  of  each  of  the  arms,  and  the 
technique  of  the  preceding  section  can  then  be  used  to  define  critical 
positions  of  the  cart,  partition  the  2-D  space  of  positions  of  the  cart 
into  connected  noncritical  regions,  and  build  a  connectivity  graph  in 
much  the  same  way  as  before. 

If  the  motion  of  the  cart  is  unrestricted,  then  the  above 
technique  can  still  be  applied,  but  now  we  must  project  FP  onto  the  3-D 
space  of  free  positions  of  the  cart.  This  leads  to  a  more  complicated 
problem,  since  we  will  have  to  partition  this  3-D  space  into 
noncritical  regions.  Although  more  difficult,  this  task  can  still  be 
attacked  by  methods  similar  to  those  developed  in  [SS2]. 

All  the  preceding  generalizations,  including  the  algorithm 
developed  in  Section  1,  are  based  on  the  availability  of  an  algorithm 
for  planning  the  motion  of  a  ladder.  As  similar  algorithms  are 
developed  for  more  complex  systems,  it  will  generally  be  possible  to 
use    these   algorithms   as   a   basis   for   developing   motion-planning 


algorithms  for  systems  involving  special  decomposable   combinations   of 
arbitrarily  many  such  "basic"  systems. 
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